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Abstract 

We propose a new position control strategy for VTOL-UAVs using IMU and GPS measurements. Since there is no sensor 
that measures the attitude, our approach does not rely on the knowledge (or reconstruction) of the system orientation as 
usually done in the existing literature. Instead, IMU and GPS measurements are directly incorporated in the control law. 
An important feature of the proposed strategy, is that the accelerometer is used to measure the apparent acceleration of the 
vehicle, as opposed to only measuring the gravity vector, which would otherwise lead to unexpected performance when the 
vehicle is accelerating (i.e. not in a hover configuration). Simulation results are provided to demonstrate the performance of 
the proposed position control strategy in the presence of noise and disturbances. 
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1 Introduction 

The design of position controllers for Vertical take- 
off and landing (VTOL) unmanned airborne vehicles 
(UAVs) has been the focus of several research groups, 
which has resulted in significant breakthroughs in this 
field, for example see (Abdessameud and Tayebi, 2010), 
(Aguiar and Hespanha, 2007), (Frazzoli et al, 2000), 
(Hauser et al, 1992), (Hua et al., 2009), (Pfiimlin et al, 
2007) and (Roberts and Tayebi, 2011a). Existing posi- 
tion controllers, usually require that the system states 
are accurately known or measured, namely the position, 
linear velocity, angular velocity and the orientation. For 
outdoor applications a global positioning system (GPS) 
mounted to the system can be used to provide the po- 
sition and velocity measurements, while the angular 
velocity is obtained using a gyroscope which is included 
in the inertial measurement unit (IMU) in addition to 
an accelerometer and a magnetometer. However, there 
does not exist any sensor that provides directly the 
orientation of a rigid body. Motivated by this problem, 
the study of rigid-body attitude estimation has seen sub- 
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stantial breakthroughs due to the efforts of the research 
community (see, for instance, (Mahony et al., 2008) ). 
However, we are not aware of any work in the literature, 
providing a rigorous results for the combination of an 
attitude observer and a position controller for VTOL- 
UAVs. 

To address this shortcoming, there has been some effort 
to design position control algorithms which do not di- 
rectly require the measurement of the system attitude. 
For example, in (Roberts and Tayebi, 2011b) the authors 
propose a position control law which utilizes a number 
of vector measurements as a means to eliminate the 
requirement for the attitude measurement. By vector 
measurements we are referring to the body-referenced 
measurements of vectors whose coordinates are known 
in the inertial frame. Since the vector measurements 
contain information about the system orientation, it 
has been shown that they can be applied directly to 
the position controller thereby eliminating the need of 
the observer completely. Consequently, the resulting 
vector-measurement-based position control laws do not 
require the direct measurement of the system attitude, 
nor do they require an attitude observer which provides 
practitioners with a simpler, reduced order closed loop 
system, with accompanying proofs for stability. 
Unfortunately, the vector-measurements based posi- 
tion control strategy can be susceptible to a problem 
associated with the lack of sensors which can provide 
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suitable vector measurements. This shortcoming stems 
from the fact that the two sensors most commonly used 
to provide vector measurements are the magnetome- 
ter and accelerometer, used to provide body-referenced 
measurements of the Earths magnetic field and gravity 
vector, respectively. However, in order to satisfy the 
requirement that the accelerometer provides a measure- 
ment of the gravity vector only, one must assume that 
the body-fixed frame is non-accelerating. It is clear that 
this condition is not guaranteed to be satisfied in some 
applications involving VTOL UAVs. 
Of course, this practical limitation is relevant to both 
vector-measurement-based position controllers and at- 
titude observers which use accelerometers. Fortunately, 
this limitation has led to the development of a new 
class of attitude observers which uses the accelerometer 
(and magnetometer) to provide vector-measurements. 
This type of observer acknowledges the fact that the 
accelerometer measures a combination of the gravity 
vector and the acceleration of the rigid-body in the 
body- fixed frame. This combination of the gravity vec- 
tor and linear acceleration in the inertial reference frame 
is commonly referred to as the apparent acceleration. 
This inertial vector violates the requirement of many of 
the vector-measurement-based attitude observers, since 
the system acceleration is not known in the inertial 
frame of reference. In order to deal with the fact that 
the inertial vector is unknown, this type of attitude ob- 
server uses the velocity of the rigid-body (assumed to 
be measurable using, for instance, a GPS) in addition 
to the signals obtained from an IMU. These attitude 
observers, which are often referred to as velocity- aided 
attitude observers, can be found in (Bonnabel et al., 
2008), (Martin and Salaiin, 2008) and (Martin and 
Salaiin, 2010) with local stability proofs , and in (Hua, 
2010) with almost semiglobal stability results. 
In this paper we propose a new position control ap- 
proach which obviates the requirement of the system 
attitude measurement by using the vector measure- 
ments directly in the control law. We specifically use 
a magnetometer and accelerometer to provide the two 
vector measurements. The accelerometer is used to mea- 
sure the system apparent acceleration, rather than the 
gravity vector only. Using our proposed approach, we 
show that, upon a suitable choice of the control gains, 
all system states remain bounded, and the system po- 
sition converges to a constant reference position. Our 
proposed control strategy 1) does not require direct 
measurement of the system attitude; 2) does not require 
the use of an attitude observer; 3) uses an accelerometer 
to provide a vector measurement without limiting the 
motion of the system to a near-hover state. 

2 Background 

In this section we present some of the necessary mathe- 
matical details we use throughout the paper. In section 
2.1 we describe two commonly used attitude representa- 



tions (rotation matrices and unit-quaternion). In section 
2.2 we define functions which are necessary in develop- 
ing the proposed control laws. 

2.1 Attitude Representation 

To represent the orientation of the aircraft (rigid-body) , 
we define two reference frames: An inertial frame X, 
which is rigidly attached the Earth (assumed flat), and 
a body frame 3 which is rigidly attached to the aircraft 
center of gravity (COG). The orthonormal basis of B is 
taken such that the x axis is directed towards the front 
of the aircraft (or rigid body), the y axis is taken to- 
wards the starboard (right) side, and the z axis is di- 
rected downwards (opposite the direction of the system 
thrust). 

Throughout the paper we often refer to the orientation 
of the rigid-body, by which we mean the relative an- 
gular position of B with respect to X. The goal of the 
attitude representation is to mathematically describe 
the orientation of the rigid-body. The unit-quaternion, 
which is a unit vector on R 4 , is given by Q = (i], q) G Q, 
where n e M is the quaternion-scalar and q e M 3 is the 
quaternion- vector, and Q is the set of unit-quaternion 
defined by 

Q = {Q G R x M 3 , IIQH = 1} . (1) 

Let Qi = (r/i,^) e Q, Q 2 = (r?2,<72) € Q denote two 
unit-quaternion; then the quaternion product of Qi and 
Q2, denoted by Q3 — (773,93) e Q is defined by the 
following operation 

Q3 = Q1QQ2 = ( 771172 - <7i~<?2, V1Q2 + mil + S(qi)q 2 ) ■ 

(2) 

The set of unit-quaternion Q forms a group with the 
quaternion multiplication operation 0, with the quater- 
nion inverse Q~ x = (77, —q), and identity element 
(1, 0) = Q- 1 Q = Q Q- 1 . The unit-quaternion is 
an over-parameterization of the the special group of or- 
thogonal matrices of dimension three 5*0(3), defined as 

S*0(3) = {R e M 3x3 , \R\ = 1, R T R = RR T = 1} , (3) 

that is, the transformation from the quaternion space Q 
to SO(3), given by the following Rodrigues formula: 

R(Q) = I + 2S(q) 2 -2 V S(q). (4) 

where S(-) is a skew-symmetric matrix given in the next 
section, is a two-to-one map, i.e., R(Q) = R(—Q). 

2.2 Skew symmetric matrices and bounded functions 

Let x,y g R 3 . We define the skew-symmetric matrix 
S(x) such that S(x)y = x x y, where x denotes the 
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vector cross product. Several useful properties of this 
skew-symmetric matrix are given below: 

S{x) 2 = xx T - x T xI 3x3l (5) 
S{Rx) = RS(x)R T , R e 50(3), (6) 
S(x)y = -S(y)x = x x y, (7) 

X(S(xf)=[o, -\\ x \\ 2 , -\\x\\ 2 ], (8) 
where A(M) denotes the eigenvalues of the matrix M G 

R 3X3_ 

Consider the bounded, differentiable function, denoted 
as h(-) : R 3 — > M. 3 , which satisfies the following proper- 
ties: 



u T h(u) > 
< \\h(u)\\ < 1 
0< U(u)\\ < 1 




,\\u\\ € (0,oo), 



u|| e [0, oo), 



(9) 



where 4>{u) :— -§-h{u). Throughout the paper we 
make use of one particular example given by h(u) = 

(l + u T uj u. Using this definition for h(-) one can 

derive the expression </>(u) = (1 + u T u)~ 3 / 2 (I 3x3 — 
S(u) 2 ).. 

3 Position Control Using GPS and IMU Mea- 
surements 

Using the above mathematical background, we will now 
proceed to formulate the problem and define the posi- 
tion control laws. A number of steps are taken which are 
grouped into various sections. In section 3.1 we define 
the system model. In section 3.2 we formulate the prob- 
lem and state some necessary assumptions. Section 3.3 
provides an attitude extraction algorithm which allows 
us to specify a desired system attitude based upon the 
values of the position and velocity error, and section 3.4 
defines attitude error functions. Finally, in section 3.5 
we describe the position control laws. 

3.1 Equations of Motion 

To model the system translational dynamics, we let 
p, v e R 3 denote the position and velocity, respectively, 
of the vehicle COG expressed in the inertial frame I. 
For this problem we assume that the body-referenced 
angular velocity vector uj is available as a control input. 
We consider the following VTOL UAV model: 



p = v, 

v = fj, + S, /i = ge 3 - u t R T e 3 , 



-Q 

Vhx3 + S(q) 



(10) 
(11) 

(12) 



where u t = T/mb, T is the system thrust, m& is the sys- 
tem mass, e 3 = col [0, 0, 1], g is the gravitational accel- 
eration, and S is a disturbance which is dependent on 
aerodynamic drag forces. The control input of the sys- 
tem is defined as u — [it t ,w] T . The system output is de- 
fined as y = [p, v, &i, 62] where hi is the signal obtained 
using an accelerometer, b\ = Rr\ is a signal obtained 
using a magnetometer, and t\ is the magnetic field of 
the surrounding environment (assumed constant). Note 
that the system attitude R (or Q) is not assumed to be 
a known output of the system. 

We consider a well-known model for the accelerometer 
model (which includes forces due to linear acceleration 
v) which is given by 

b 2 = R(v- ge 3 ) = -u t e 3 + RS = Rr 2 , (13) 

where r 2 is the inertial referenced system apparent ac- 
celeration, which satisfies 



v = ge 3 + r 2 , r 2 



u t R T e 3 + 5. (14) 



In the development of attitude observers, it is often as- 
sumed that the system is near hover (or v w 0) in order 
to assume that the accelerometer measures the direc- 
tion of the gravity vector. Also, in most situations the 
aerodynamic disturbance vector 5 is not included in the 
model. However, for the VTOL UAV model, one can eas- 
ily see that if the aerodynamic disturbance is neglected, 
or we assume that 5 ~ 0, then the accelerometer sig- 
nal provides the measurement b 2 — —u t e 3 , which is the 
constant vector e 3 multiplied by the system thrust. In 
this case the use of the accelerometer seems trivial since 
its measurement is known a priori and does not contain 
any information about the system attitude. Therefore, 
we see that for the VTOL UAV system, the assumption 
that the accelerometer measures only the gravity vector 
may be a dangerous assumption which may lead to un- 
expected performance, even in the case where v s=s 0. In 
fact, it seems that the utility of the accelerometer mea- 
surements is related to the measurement of the vector 5 
since the accelerometer measures b 2 = — Ute 3 + RS. For 
this reason we believe that it is important to include a 
model of the aerodynamic disturbances. 

3.2 Problem Formulation 

Let p r denote a desired reference position, which is as- 
sumed to be constant (or slowly- varying) , and let e p — 
p — p r . Our main objective is to develop a control law for 
the system inputs Ut and to, using the available system 
outputs y = [p, v, bi, b 2 ], such that the system states e p 
andf are bounded and limi^oo e p (t) = lim^oo v(t) = 0. 
For the position control design we first require the fol- 
lowing assumptions are satisfied. 
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Assumption 1 There exist positive constants c\ and C2 
such that ||r2(£)|| < c\ and ||r2(i)|| < ci- 

Assumption 2 Given two positive constants, 71 and 72, 
there exists a positive constant c w (7i, 72) such that c w < 
\min(W) where W = -71SM 2 - 72^ 2 ) 2 . 

The second assumption is satisfied if r 2 is non- vanishing 
and is not collinear to the magnetic field vector r\. In 
the case where r2 = 0, the system velocity dynamics be- 
come v = ge 3 (which corresponds to the rigid body be- 
ing in a free-fall state) which is not likely in normal cir- 
cumstances. When this assumption is satisfied, it follows 
that W is positive definite. Furthermore, if this assump- 
tion is satisfied, the value of c w > can be arbitrarily 
increased by increasing the values of 71 and 72. 
In addition to this assumption, we also require some con- 
ditions on the aerodynamic force vector 5. 

Assumption 3 (Aerodynamic Forces) In light of 
the fact that the disturbance force S is due to aerody- 
namic forces exerted on the vehicle we make the following 
simplifying assumptions: 

(a) The aerodynamic disturbance 8 is dissipative with 
respect to the system translational kinetic energy and 
satisfies S T v < 0. 

(b ) The aerodynamic disturbance force 5 is only depen- 
dent on the system translational velocity, and there 
exist a positive constant c\ such that ||<5|| < ci||v|| 2 

(c) There exists positive constants c^ and c 3 such that 
\\S\\ < c 2 +c 3 \\v\\ 3 . 

Assumption 3(a) and 3(b) can be realized when the sys- 
tem is operating in an environment where the exogenous 
airflow is negligible (no wind). Assumption 3(c) can be 
satisfied when the system geometry is sufficiently sym- 
metrical such that the system aerodynamic forces do 
not significantly depend on the system orientation. Al- 
though this assumption may be reasonable for certain 
VTOL type aircraft, for example the ducted-fan, this as- 
sumption may not be the case with certain systems, for 
example fixed wing aircraft, where the system aerody- 
namics depend largely on the orientation of the vehicle. 
Now that we have established the required assumptions, 
let us consider the model for the system acceleration 
from (11). Due to the under actuated nature of this sys- 
tem, the translational acceleration is driven by the sys- 
tem thrust and orientation fi(u t ,R). That is, if fi was a 
control input, setting \i = —k p e p — k v v would satisfy the 
objectives (since v T 6 < 0). However, since /x is a func- 
tion of the system state, we define \i d e M 3 as the desired 
acceleration, and introduce the new error signal 



(1 = jJL- fl d - 



(15) 



Subsequently, a new objective is to force fj, — > in order 
to obtain the desired translational dynamics. Since the 



signal /x is dependent on the system thrust and attitude, 
based upon the value of the desired acceleration \i d we 
wish to obtain a suitable desired attitude, denoted as 
Qd = {Vd,Qd) € Q, and system thrust u t , such that the 
following equation is satisfied 



= 9 e 3 - u t Rje 3 , 



(16) 



where R d — R (Qd) is the rotation matrix corresponding 
to the unit-quaternion Qd, as defined by (4). An extrac- 
tion method satisfying these requirements, which has 
been previously given in (Roberts and Tayebi, 2011a), is 
described in the following section. 

3.3 Desired Attitude and Thrust Extraction 

In this section, given a value of the desired acceleration 
fi d , we seek to obtain the value of the desired orientation 
Rd (or equivalently in terms of the unit-quaternion Qd) 
such that equation (16) is satisfied. To solve this problem 
we use an attitude and thrust extraction algorithm which 
has been previously proposed by (Roberts and Tayebi, 
2011a): Given [id where fid ^ L, 

L = {fi d e R 3 ; fi d = col[0, 0, /x d3 ]; /x d3 G [g, 00)}, (17) 

then, one solution for the thrust u t and attitude Qd = 
(id, Qd) where Rd = R(Qd), which satisfies (16) is given 

by 



u t = WfJ-d - ge 3 \\, 

( l ( \ 9- ej^d 



1/2 



1 



id 



-S(nd)e 3 . 



1\\nd - gez\\r]d 
The extracted attitude Qd has the time-derivative 



(18) 
(19) 
(20) 



Qd = \ 



Ud, 



(21) 



Vdhx3 + S(q d ) 
where the desired angular velocity LOd is given by 

u d = M{fi d )ii d , (22) 

M(fi d ) - t4-T (-4S(fi d )e 3 eJ + An 2 d u t S{e 3 ) + 2S([i d ) 
ir ld u t 

-2eJn d S(e 3 ))S^ d -ge 3 ) 2 . (23) 
34 Attitude Error 

To represent the relative orientation of the desired at- 
titude Q d with respect to the actual attitude Q, we let 
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Q = (fj, q) e Q and R = R(Q) e 50(3) denote the un- 
known attitude error which is defined by 



the control input cu. The proposed control law is given 
as follows: 



Q = QG)Q d 



R = R(Q) = R T d R, (24) 



where Q d is the unit quaternion obtained using (19) and 
(20). In light of Q and Q d , as defined by (12) and (21), 
respectively, the time derivative of the attitude error is 
found to be 



rjl + S(q) 



R = -S(u)R, 



(25) 



(26) 

where u>d is the desired angular velocity as defined by 
(22). One of the objectives of the control design is to 
force the system orientation to the desired attitude, or 
in terms of the rotation matrices, to force R — > Rd (and 
therefore fi — > /Ltd), in order to obtain the desired transla- 
tional dynamics. As mentioned in section 2.1, this corre- 
sponds to two possible solutions for the unit-quaternion 
which arc given by Q = (±1, 0). The multiplicity of equi- 
librium solutions is manageable since our objectives are 
satisfied for both values of the unit-quaternion. 

3.5 Position Controller 

The position controller design is based upon a value of 
the desired system translational acceleration, which is 
specified by the virtual control law fid- Using the calcu- 
lated values for the position error e p = p — p r , and the 
system velocity v, the value of the desired acceleration 
is obtained. This desired acceleration is directly related 
to a corresponding desired rigid-body orientation and 
thrust, denoted by Qd and u t , respectively, which is ob- 
tained using the attitude and thrust extraction method 
described in section 3.3. The desired attitude given in the 
50(3) parametrization, denoted as Rd, is subsequently 
obtained using Qd with (4). Since the system attitude 
is not known, we incorporate the use of a special filter 
which is driven by the value of the linear velocity v. We 
let v <G R 3 denote the filter state variable which cor- 
responds to the system velocity v, and define the error 
function v = v — v. 

Although the system linear velocity is known, the use 
of the signal v through the error function v, for an ap- 
propriate choice of the estimation law v can can be 
viewed as a function of the system acceleration in terms 
of the unknown signal r 2 . Since this vector is known in 
the body fixed frame (measured using an accelerometer, 
b 2 = Rr-i), the filter variable v through the error func- 
tion v can be used with the accelerometer to provide 
information related to the system attitude. After these 
steps, the remaining control design is focused on forcing 
the actual system attitude to the desired attitude using 



w - M(p d ) (/„„ - k v 0(v)R T d (b 2 + u t e 3 )) + V, (27) 

fn d = -k p 4>(e p )v + k v (f>(v) (k p h(e p ) + k v h(v)) , (28) 

i> = 715(^)6! + l2 hS (R d (v - v)) b 2 , (29) 

v = ge 3 + R T d b 2 + k!{v-v) + ^-R T d S(b 2 )^ 7 (30) 



-k p h{e p ) — k v h(v), 



(31) 



where fci,7i,72 > 0, M(fid) is the function defined by 
(23), <f>(-) is the bounded function defined in section 2.2, 
ut = || - 5e 3 ||, Rd = R{Qd) and Q d = (%, qd) is ob- 
tained from the value of fid using the attitude extraction 
algorithm defined in section 3.3. 

Theorem 1 Consider the system given by (10)-(12), 
where we apply the control laws ut — Wnd — ge-a\\ anduj as 
defined by (27), where k p > and k v > are chosen such 
that k p + k v < g. Let assumptions 2 and 3 be satisfied. 
Then the system thrust ut is bounded and non-vanishing 
such that 

< c t < u t (t) < ct, c t =g-k p -k v , c t = g+k p +k v , 

(32) 

and for all initial conditions fj(t ) ^ (or equivalently 
\\q{to)\\ 7^ 1J; there exists positive constants 71,72, «i > 
such that for 71 > 71, 72 > 72, k\ > K\, the system states 
e p andv are bounded andlmi^^ e p (t) = lim^oo v(t) = 
0. 



Proof: We begin by first proving the upper and lower 
bounds on the thrust control input u t ■ Since the function 
h(-) is bounded by unity, the norm of the virtual control 
law fi d is bounded by \\fi d \\ < k p + k v . Since the thrust 
control input is given by u t — \\fi d ~ 9&3 \\- and k p and 
k v are chosen such that k p + k v < g, one easily arrives 
at the lower and upper bounds for u t described in the 
theorem. A nice consequence of the boundedness of u t , 
is that the function M(fid) defined by (23), which is used 
in the expression for the desired angular velocity u> d , is 
also bounded. In fact, in (Roberts and Tayebi, 2011a) 
the authors show that the norm of this matrix satisfies 



\\M{fi d )\\ < V2/c t 



(33) 



We now focus our attention on the dynamics of the po- 
sition error e p = p — p r and the system velocity v. Let 
fi = fi — fi d , where fi is the function defined by (11). In 
light of the choice for fi d , the derivatives of the position 
error and velocity can be written as 

e p = v, v = — k p h(e p ) — k v h(v) + fi + S. (34) 

As previously mentioned, the velocity observer error v = 
v — v is considered as a function of the apparent acceler- 
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ation vector r 2 . In fact, we define an error function asso- 
ciated to the apparent acceleration r 2 which is given by 

r 2 = kiv- (I-R)r 2 . (35) 

Another important error function which we will focus 
on is the attitude error function R, or equivalently Q — 
(fj, q), which defines the relative orientation between the 
actual system attitude and the desired attitude. To prove 
the theorem, we will construct a Lyapunov function in 
terms of the error functions q, f 2 , v and e p , in order 
to show that all of these states tend to zero. Since the 
dynamics of q (or equivalently fj), and f 2 are some- 
what complicated, we will begin by first simplifying the 
expressions for their derivatives. In order to analyze 
the dynamics of the attitude error, it is sufficient to 
study the derivative of the quaternion-scalar fj. This 
is also desired since the derivative of the quaternion 
scalar can be less complicated than the derivative of the 
quaternion vector. As a starting point, the derivative 
of fj can be found from (25) to be fj = —q T £j/2 where 
Co = Rj(u — U! d ) and tod — M(/Xd)jxd- To find a result for 
the desired angular velocity ujd we first use the results 
(34), in addition to the derivative of the bounded func- 
tion h(-), denoted as </>(•) as defined in section (2.2), to 
differentiate the virtual control law [id to obtain (id = 
—kp4>(e p )v — k v <j)(v) (—k p h(e p ) — k v h(v) + fx + S) . Sim- 
plifying this result, we obtain the following expression 
for the desired angular velocity 

uj d = M(n d ) (fn d - k v 4>(v)5 - k v (f>(v)fx) . (36) 

Recall the control input oj uses the function tp, given 
by (29). Using (35), the property (6) and the fact 
S(Rr 2 )Rr 2 — 0, tjj can be rewritten as 

yj = Rd(liS(r 1 )Rr 1 + l2 S(r 2 )Rr 2 + l2 S(f 2 )Rr 2 ). (37) 

Finally, using the expression for the control input 
<jj, the error function f 2 , in addition to (36), (37) 
and the fact b 2 + u t e^ = RS, we find the deriva- 
tive fj = -\f? Rj^RdSir^Rn + l2 R d S(r 2 )Rr 2 + 

j 2 R d S(f 2 )Rr 2 +k v M([i d )<f)(v)(I-R)5+k v M([i d )<t>(v)rjy 

To further simplify this result, we first recognize that 
in light of the definition of the rotation matrix from (4) 
and the property S(u)u = 0, one can find q T S(ri)Rri — 
2q T S(n) (qq T - fjS(q)) r, = 2fjq T S^rfq. Therefore, 
using the expression for the matrix W defined by as- 
sumption 2, we obtain 

fj = f]q T Wq - ^q T S(f 2 )Rr 2 

- ^q 1 R T d M(nd)4>(v) ((/ - R)S + A) • (38) 

Note that due to assumption 2, the matrix W is positive- 
definite. We now shift our focus to study the dynamics of 



the error function f 2 . In light of the expression for v from 
(14), the expression for v from (30), the attitude error 
dynamics from (25)- (26), the expressions (27), (36), and 
using the fact that — kiv + r 2 — R T b 2 = — f 2 , we obtain 

f 2 = -kif 2 - (I - R)f 2 

+ k v R^S(b 2 )M^ d )4>(v)((I - R)6 + fx). (39) 

A commonality between the dynamic equations for fj and 
f 2 , is that they both depend on the error functions (I—R) 
and fx. These two error functions can both be expressed 
in terms of the attitude error using the quaternion vec- 
tor part q, which will be a useful characteristic later in 
the Lyapunov analysis. To describe this relationship we 
define two functions, fi(u t ,fj, q),f 2 (x, fj,q) G M 3x3 such 
that 

A = h(u t ,fj,q)q, {I-R)x = f 2 (x,fj,q)q, (40) 

where x £ M 3 . Using the definition of fx = jx — /x d , 
in addition to the expressions for [i and fid from (11) 
and (16), respectively, one can find fi(u t ,fj,q) = 
2u t (fjI-S(q))S(R T e 3 ) and f 2 (x,fj,q) = 2{S{q) - 
fjT)S(x). Based upon these definitions and the fact that 
\\fjl — S(q)\\ = 1, we find the following upper bounds for 
these two functions 

\\fi(u t ,fj,q)\\ < 2ct, \\f 2 (x,fj,q)\\ < 2\\x\\, (41) 

We now propose the following Lyapunov function can- 
didate: 

V = ~/k p ^l + eje p - \}+l v T v+^f T 2 f 2 + lq (1 - fj 2 ) , 

(42) 

where 7, j q , k p and k r are positive constants. In light of 
(34), (38), (39), we have 

V = — ~fk v v T h(v) + ~/v J S — jk r kifjf 2 — 2j q fj 2 q T Wq 
+ -fk v k r fjRjS(b 2 )M(n d )<jy(v) (h{u t , fj, q) 

+ h {S,fj,q))q- lk r f~lf 2 (f 2 ,fj,q)q + jv T /1 (u t ,fj,q)q 
+ "f q k v fjq T RjM(n d )<j)(v) (fi(u t ,fj, q) + f 2 (5, fj, q)) q 
+ l2l q m T S{f 2 )itr 2 . (43) 

Now, we wish to show that for an appropriate choice of 
the control gains, V is guaranteed to be non-positive. 
However, this objective is a bit involved, and therefore 
requires we study the bound of several functions used in 
the expression of V . We begin this analysis by defining 
the function scalar function a(t) := ^/2V(t). 
Based upon the definition of V from (42), the states v 
and f 2 are bounded by a as follows ||u(t)|| < u(t)/^/7, 
11^2(011 ^ &(t)/\/jk r . Therefore, in light of assumption 
3(b), one can conclude that 

\\S(v)\\ < Cl a(tfh- (44) 
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Due to the bounds of the functions fi(ut,fj,q) and 
f 2 (5,fj,q) from (41), and the definition of r 2 from (14) 
we also find 

\\fi(u t ,fj,q) + fc(6,fj,q)\\ <2{ 1 c t + c 1 a{tf) h (45) 
INI < {jc t + Cl a{t) 2 ) /j. (46) 

Given these bounds, we now apply Young's inequality to 
a number of the undesired terms in the expression for V: 



jv 1 fi(u t ,r),q)q 
'l / ei 



l2lqVQ S(r 2 )Rr 2 



< — u + 

2 £i 



VtT^) 2 ^, 



(47) 

-fk v k r rjR}S(b 2 )M(p d )<j)(v) (fi(u t ,rj,q) + h{5,rj,q)) q 
"fk v k r e 2 -t~ 

7fc„/c r /2\ /4(7c t + cicr(t) 2 ) 4 \ _ j _ 

11 —\qq 



2e 2 



7" 



: r 2 r 2 + 5-, 

I e 2 j 3 ci 



(48) 

where the norm of M(p, d ) is given by (33). To determine 
the bound of the term involving the time-derivative of 
r 2 , we first derive the expression for f 2 to be 

f 2 = -u t R J e 3 + u t R T S(e 3 )oj + S 

= (p-d - ge 3 ) T ( - k p (j)(e v )v - k v <p(v)fi(u tl f),q)q 

+k v <j)(v) (k p h(e p ) + k v h(v)) - k v (j>{v)5^ R T e 3 
+u t R T S(e 3 ) ^M(nd) ( - k p <j>(e v )v - k v cj>(v)R5 
+k v (f>(v) (k p h(e p ) + k v h(v)) ) + jiS(R d ri)bi 
+!2RdS(h)Rr 2 + l 2 R d S(r 2 )Rr 2 ) + 5. 



(49) 

Due to the bounds of the functions h(-), (/>(•), the (upper 
and lower) bounds of the thrust control input u t , the 
bound of 5 from assumption 3(c), the bound of b 2 from 
(46) (same as the bound of r 2 ), and the bound of S from 
(44), we find that there exists five positive constants 
di > 0, such that the norm of r 2 is bounded by r 2 < 
d 1 +d2\\v\\+d 3 \\v\\ 2 + d 4 \\v\\ 3 + d 5 \\v\\ 4 . However, for the 
sake of simplicity, from this result we further conclude 
that there exists positive constants c 3 and C4 such that 
^2 < C3 + C4(r(t) 4 . As a result of this analysis, we again 
use Young's inequality to establish the following bounds: 



7k r rjf 2 (f2,rj,q)q 

,jk r e 3 „ T „ 2 7 fc r - 2 

< — r— r 2 r 2 H (c 3 + aa(t) ) q q, 

* £3 



(50) 



< 



727g£4~ T ~ Iq 



-r 2 r 2 



2^2,-r, ( 51 ) 



(c t7 + cicr(t) 2 ) rfq q 



2 z " ' 27 2 e 4 
~f q k v fiq T R T d M(p d )(j>{v) (fi(u t , 77, (?) + f 2 (S, r\, q)) q 

2x/2 79 fc l; ( 7 c t + c lC r(i) 2 ) T ^ 

< 9. 

7c t 

.(52) 

Recall from assumption 2 that the norm of the matrix W 
has a lower bound which is denoted as c w . Therefore, in 
light of the lower bounds defined above, and assumption 
3(a) we find the expression V is bounded by 

V(t) < - 1V J h(v) (k v - ei/2) 

1 { a\{t) a 2 (t) a 3 (t)\ 0:4 (i) 



if 



£l £2 £3 

^Vict (7 + "{iff 2 2V2k v {ra + cMt) 2 ) 



fj 2 



)■ 



a 1 {t)^2^,c 2 ^ 1 + a(tf/ lq , 
a 2 {t) = Ak v k r ( 7 ct + c lC r(t) 2 ) 4 /(7 3 c 2 7 g), 
ot 3 {t) = 2 7 fc r (c 3 + c 4 a(t) 4 ) 2 /7 g , 
a 4 (t)= (c t7 + Cl a(t) 2 ) 2 /(2 7 2 ). 



(53) 

(54) 
(55) 
(56) 
(57) 



Now, let us define a lower bound for |jjj|, which based 
upon some appropriate choices of gains, ensures V < 
for all t > t n . Note that when r){t) — we cannot guar- 
antee stability using (53) since in this case V could po- 
tentially be positive. To show that fj{t) is never zero, 
we first introduce the positive constant p which is the 
desired lower bound for |?)(t)|. Therefore, p must be 
chosen to satisfy < p < |??(to)|- Subsequently, based 
upon the definition of the Lyapunov function candi- 
date (42), we choose 7 = 7 (& P (\/l + |je p (to)|| 2 — 1) + 
|Hi )|| 2 /2 + ||f 2 (t )|| 2 /2 + where the parameter 

£ is chosen to be positive, and 7 is chosen to satisfy 
< 7 < 7 g (rj{to) 2 — p 2 ) , where j q is chosen to be pos- 
itive. Recall k p > and k v > are chosen arbitrarily 
provided that k p + k v < g. The remaining gains and pa- 
rameters are chosen to ensure that all terms in (53) are 
guaranteed to be negative at the initial time to- The gains 
and parameters are chosen as follows: Choose ei such 
that < ei < 2k v . Recall that the minimum eigenvalue 
of W, denoted by c w > 0, can be increased using the 
gains 71 and 72. Therefore, there exists constants 71,72, 
and ei, i — 2,3, 4, such that for all 71 > 71, 72 > 72, and 
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£j > £j, the following inequality is satisfied 

1 /ai(t ) . a 2 (to) . «3(*o)\ . a 4 (*o) 

2c™ > — 1 1 H 

p l \ ei e 2 e 3 / e 4 

( 2/75' (7 + v(to) 2 ) 1/2 | 2V2fc„ (jc t + ciafa) 2 ) 

P 2 7c t/ o 

(58) 

Finally, choosing fci > Ki(e 2 , £3, £4, 7) : = (e2fctj + £3)/2 + 
( £ 4727?)/(27fcr) we conclude that V(io) < at the ini- 
tial time to. We now need to show that this is true for 
all time. Since the functions a\{t) through 04 (t) arc 
non- increasing if V" < 0, then a sufficient condition for 
V(t) < is \fj(t)\ > p. We will now show that indeed 
P — I 'KOI f° r au t > to. Suppose that there exists a time 
ti such that for all to < t < t\, \rj(t)\ > p and < p 

when t = t\. At the time t\ from (42), it is clear that 

V(ti) > 7 9 (1 - »K*i) 2 ) > 7« (1 - P 2 ) ■ However, 
due to the choice of 7 and 7 the value of the Lyapunov 
function candidate at the initial time to must satisfy 
V(t ) < 7 + 7 9 (l - v(to) 2 ) < lq (l - P 2 ) and therefore 
V(t\) > V(to). This is a contradiction since V(i) < for 
all to < t < tx, and the functions V(t), ai(t) and a(t) 
are non-increasing in the interval to < t < t%. Therefore, 
we conclude that \rj(t)\ > p and V(t) < for all t > to, 
and the states v and f 2 are bounded. Therefore, f 2 , v, 
fj, and V are bounded. Invoking Barbalat's Lemma, one 
can conclude that lim^oo (v(t), r 2 (t), q(t)) — 0. Fur- 
thermore, since lim^oo ii(t) = 0, and lim^oo 5(t) = 0, 
it follows from the expression of the velocity dynamics 
v = —k p h(e p ) — k v h(v) — 5 = 0, that lim f _ ! . 0O e p (t) = 0, 
which ends the proof. ■ 

4 Simulations 

Simulation results have been provided for the system de- 
fined by (10)-(12) with the proposed control laws (27)- 
(31), which are shown in Figure (1). To demonstrate the 
robustness of the proposed control strategy, we have in- 
cluded in our simulations the presence of wind, sensor 
noise and gyro-bias. A much more aggressive aerody- 
namic model is adopted during the simulations, which 
violates the assumptions in order to demonstrate the ro- 
bustness of the proposed controller. This aerodynamic 
model considers that the aerodynamic drag of the system 
is a function of the system attitude, and also considers 
that the system is operating in the presence of uniform 
wind. The following model was used for the aerodynamic 
disturbance 5: S = — ^\\v — v w \\R T Cd,R(v — v w ) where 

v w g IR 3 is the inertial referenced wind velocity vector, 
m b is the system mass and Cd = Cj > is a constant 
positive definite matrix that represents body-referenced 
aerodynamic drag coefficients that are dependent on the 
system geometry. Note that the expression for S depends 
on the mass nib of the system due to the definition of 
the velocity dynamics from (11). A constant wind ve- 
locity vector was specified [10,5,0]m/s. For 
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Fig. 2. Velocity v(m/s) 

this simulation the value Cd = diag [0.1, 0.1, 0.05] kg/m 
was chosen and the system mass was specified as mb = 
5kg. Gaussian noise was added to the magnetometer, 
accelerometer, gyroscope, linear velocity and position 
sensors with standard deviation values equal to 0.01G, 
O.lm/s 2 , O.ldeg/s, 0.5m/ s and 0.5m, respectively. A 
bias was also added to the gyro measurements which 
was chosen as [0.1, 0.05, —0.2]deg/s. The system gains 
were chosen as follows: k p = 5, k v = 0.1, 71 = 0.1 = 
72 = 0.05 and ki = 5. The following initial conditions 
were used: p(to) = [150,50, 0]m, v(t n ) = [0, 0,0] m/s, 
v(t ) = [0,0,0], Q(t ) = [1,0,0,0], and the desired po- 
sition was chosen as p r = [0,0,0]. The inertial vec- 
tor for the magnetometer measurement was chosen as 
r% = [0.18, 0, 0.54]G, which is consistent with the magni- 
tude and direction of the Earths magnetic field in South- 
ern Ontario, Canada. The simulation results show that 
the system position converges to the desired value, ex- 
cept for a small error attributed to the sensor noise, gy- 
roscope bias and the effect of the aerodynamic distur- 
bance caused by wind. 

5 Conclusion 

A new position controller for VTOL-UAVs that does not 
require direct measurement of the system's attitude, nor 
does it require the use of an attitude observer has been 
proposed. The accelerometer and magnetometer signals 
are explicitly used in the control law to capture the nec- 
essary information about the system's orientation (with- 
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Fig. 3. Control Effort (Angular Velocity) u 
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Fig. 4. Control Effort (Thrust) T = itt ■ m b (TV) 

out, explicitly, reconstructing or estimating the orienta- 
tion). Furthermore, the usual simplifying assumption re- 
stricting the accelerometer measurement to the gravity 
direction is not required anymore. In fact, in this work, 
the accelerometer is used to measure the system's appar- 
ent acceleration, which makes the proposed control effi- 
cient when the system is subjected to significant linear 
accelerations. We have shown that, through an appro- 
priate choice of the control gains, the system position is 
guaranteed to be bounded and to converge to the desired 
position for almost all initial conditions. Simulation re- 
sults have also been performed which demonstrate the 
effectiveness of the controller, despite the choice of rela- 
tively low control gains, and large initial conditions. 
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